
#ifndef __QUATERNION_SOLUTION_H_
#define __QUATERNION_SOLUTION_H_
#include "bichon_robot.h"
float InvSqrt(float number);
void Quaternion_Solution(float gx, float gy, float gz, float ax, float ay,
                         float az);

#endif
